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METHOD AND SYSTEM FOR CORRECTING SENSOR OFFSETS 

Related Applications 

[0001] The present invention claims priority to 
provisional application no. 60/401,417 filed on August 
5, 2002. 

Technical Field 

[0002] The present invention relates generally to a 
dynamic behavior control apparatus for an automotive 
vehicle, and more specifically, to a method and 
apparatus for correcting offsets in vehicle dynamic 
sensors . 

Background 

[0003] Dynamic control systems for automotive 
vehicles have recently begun to be offered on various 
products. Typical dynamic control systems include 
sensors corresponding to various vehicle dynamics . 
Examples thereof include: a yaw rate sensor, a roll 
rate sensor, a longitudinal acceleration sensor, and a 
lateral acceleration sensor. Typical dynamic control 
systems also include a controller that receives the 
sensor signals and controls various safety and 
stability systems in response thereto. 

[0004] During various different phases of vehicle 
operation, the aforementioned sensors tend to generate 
errors that may result in false signals received in 
the controller. 
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[0005] It would therefore be desirable to provide a 
correction or compensation system and method. The new 
system should not require additional sensors and 
should also not require shutting-down dynamic control 
sensors. The present invention is directed to these 
ends . 

Summary of the Invention 

[0006] It is therefore an object of the invention 
to provide a system for correcting for offsets within 
vehicle dynamic sensors . 

[0007] In one aspect of the invention, a sensor 
offset correction method for a vehicle includes 
generating a first offset correction signal for a 
vehicle dynamic sensor at a sensor power-up, 
generating a second offset correction signal for the 
vehicle dynamic sensor when the vehicle is moving, and 
correcting the vehicle dynamic sensor in response to 
the first offset correction signal and the second 
offset correction signal. 

[0008] In a further aspect of the invention, a 
control system for an automotive vehicle having a 
vehicle body includes a cluster of vehicle dynamic 
sensors positioned within the vehicle body adapted to 
generate a plurality of vehicle dynamic signals. 

[0009] The system may further include a controller 
adapted to receive the plurality of vehicle dynamic 
signals, generate a first offset correction signal for 
one of the cluster of the vehicle dynamic sensors in 
response to a DC bias and at a sensor power-up, 
generate a second offset correction signal for the one 
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of the cluster of the vehicle dynamic sensors in 
response to a signal equivalent to a temperature drift 
signal and when the vehicle is moving, generate a 
third offset correction signal for the one of the 
cluster of the vehicle dynamic sensors when the 
vehicle is at rest and the one of the cluster of the 
vehicle dynamic sensors is below an accuracy 
threshold, and correct the one of the cluster of the 
vehicle dynamic sensors in response to the first 
offset correction signal, the second offset correction 
signal and the third offset correction signal. 

[0010] One advantage of the invention is that 
readings from vehicle dynamic sensors are more 
accurate . 

[0011] Other objects and features of the present 
invention will become apparent when viewed in light of 
the detailed description of the preferred embodiment 
when taken in conjunction with the attached drawings 
and appended claims. 

Brief Description Of The Drawings 

[0012] Figure 1 is a diagrammatic view of a vehicle 
with variable vectors and coordinator frames in 
accordance with one embodiment of the present 
invention . 

[0013] Figure 2 is a block diagram of the vehicle 
sensor system from Figure 1. 

[0014] Figure 3 is a logic flow diagram of a method 
for compensating for offset errors in vehicle dynamic 
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sensors in accordance with another embodiment of the 
present invention . 

Detailed Description Of The Present Invention 

[0015] In the following figures the same reference 
numerals are used to identify the same components. 

[0016] Referring to Figures 1 and 2, a control 
system 18 for an automotive vehicle 19 having a 
sensing system 16 (sensor cluster) and a controller 
26, is illustrated. Various forces and moments are 
acting thereon during a rollover condition. 

[0017] The vehicle control system 18 includes the 
sensor system 16. The sensing system 16 may use a six 
control sensor set including three axial 
accelerometers including a lateral accelerometer 27 
(generating a lateral acceleration signal) , a 
longitudinal accelerometer 28 (generating a 
longitudinal acceleration signal) , and a vertical 
accelerometer 29 (generating a vertical acceleration 
signal) and three axial rotation rate detectors 
including a yaw rate sensor 30 (generating a yaw rate 
signal) , a roll rate sensor 31 (generating a roll rate 
signal) , and a pitch rate sensor 32 (generating a 
pitch signal) . Of course, those skilled in the art 
will recognize that one or more sensors may not be 
included in the system 18. 

[0018] The sensor system 16 further includes 
various other sensors, such as wheel speed sensors 20, 
a steering angle sensor 33 (hand-wheel sensor) , and 
steering angle position sensors 34 (road-wheel 
sensors) . As one skilled in the art will understand, 
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the various sensors generate a plurality of vehicle 
dynamic signals. These are further described below. 

[0019] The vehicle control system 18 may also 
include the controller 26. The controller 26 receives 
the plurality of vehicle dynamic signals and generates 
a first offset correction signal for one of the 
cluster 16 of the vehicle dynamic sensors (27, 28, 30, 
or 31) in response to a DC bias and at a sensor power- 
up. The controller 26 also generates a second offset 
correction signal for the one of the cluster 16 of the 
vehicle dynamic sensors (27, 28, 30, or 31) in 
response to a signal equivalent to a temperature drift 
signal and when the vehicle 19 is moving. The 
controller 26 further generates a third offset 
correction signal for the one of the cluster 16 of the 
vehicle dynamic sensors (27, 28, 30, or 31) when the 
vehicle 19 is at rest and the sensor is below an 
accuracy threshold. The controller 26 still further 
corrects the vehicle dynamic sensing system 16 in 
response to the first offset correction signal, the 
second offset correction signal and the third offset 
correction signal . 

[0020] Based upon inputs from the sensor system 16, 
the controller 26 may control a safety device 38. 
Depending on the desired sensitivity of the system and 
various other factors, not all the sensors are used in 
a commercial embodiment. The safety device 3 8 may 
control an airbag 40 or a steering actuator or braking 
actuator at one or more of the wheels of the vehicle 
19. Also, other vehicle components such as a 

suspension control 48 are used to adjust the 
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suspension to prevent rollover. Suspension control 48 
may include an anti-roll bar. 

[0021] In this system 18, the output signals from 
the RSC sensors (Yaw Rate Sensor 30, Roll Rate Sensor 
31, Longitudinal Acceleration Sensor 28, Lateral 
Acceleration Sensor 27) are corrected for errors by 
removing the zero output DC bias . Such bias 

constitutes an error that may occur as a result of 
temperature changes, manufacturing defects, or other 
factors. This system 18 also compensates for the 
drift in the sensor output signals that can occur 
during vehicle operation. 

[0022] In one embodiment, to reduce run time, 
calculations of the offset variables are not performed 
during Anti-Lock Brake (ABS) , Active Yaw Control 
(AYC), Traction Control System (TCS) , or Roll 
Stability Control (RSC) events. Runtime for the 
system 18 is highest during these events. The 
signals, however, are filtered and compensated during 
this time. Calculations of offset variables are also 
paused when the flag is set (one example of logic 
therefore includes: RSC_SENSORS_DISTURBED) . This flag 
is set externally when the sensors are undergoing a 
self -test, the sensor values are too high, or the rate 
of change is higher than expected. 

[0023] An example of logic therefore includes: 

If (ABS_CYCLE || AYC_CYCLE || RSC_CYCLE || TCS_CYCLE); 
(In generic terms, if ABS, AYC, TCS or RSC are active 
then the following logic runs.) 
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{of f set_comp ( ) } ; (This function compensates and 
filters out the signals from sensor.) 

else{if ( ! SENSORS_DISTURBED) {of f set_initializaton ( 
); (This function initializes the offset values.) 

if (VEHICLE_STANDSTILL) {of f set_resting ( ) ; (When 
the vehicle 19 is standing still, this function is 
called. ) 

else {of f set_signals ( ) ; } (When the vehicle 19 is 
moving, this function is called.) 

{of f set_comp ( ) } (This function compensates and 
filters out the signals from sensors.) 

[0024] One example of offset compensation external 
inputs to the aforementioned logic includes: 



RSC Code Name 


Logic Description Name 


1. Get_abs_cycle 


ABS_CYCLE 


2. Get_ayc_in_cycle 


AYC_CYCLE 


3- 

St_ROLL_FLAG . bf_bool_ACTIVE_ROLL_CONTROL 


RSC_CYCLE 


4 . Get_tcs_engine_control_active 


TCS_CYCLE 


5 . RSC_SENSOR__BITS . RSC_SENSORS_DISTURBED 


RS C_S ENSORS_DI STURBED 


6 . ss_mps_REF_VELOCITY__YC 


VEH I C LE_S PEED 


7. Get_vehicle_standstill 


VEHICLE_STANDSTILL 



[0025] There are three phases of operation 
occurring within the controller 26: 1) Initialization, 
normally occurring at electric power-on of the vehicle 
19; 2) Resting, occurring whenever the vehicle 19 is 
not in motion; and 3) Dynamic, occurring when the 
vehicle 19 is in motion. 

[0026] Referring to Figure 3, a logic flow diagram 
60 of a method for compensating for offset errors in 
vehicle dynamic sensors (27, 28, 30, or 31) is 
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illustrated. Logic starts in operation block 62 where 
a first offset correction signal or initialization for 
a vehicle dynamic sensor (27, 28, 30, or 31) is 
generated at a sensor power-up. 

[0027] Initialization of Roll Rate or roll rate 
signal and Yaw Rate or yaw rate signal occurs when the 
vehicle ignition key is turned on or electrical power 
is otherwise supplied to the vehicle systems. 
INITIAL I ZATION__COMPLETE indicates a flag is set at the 
end of initialization. Initialization eliminates 
initial D.C. bias that is present at the 
initialization . 

[0028] If the vehicle 19 is standing still when the 
ignition is turned on, the offsets are computed such 
that the filtered roll rate and yaw rate is 
approximately zero deg/sec. Other vehicle movement 
checks when standing still, such as rolling or 
turning, are also performed. Initialization continues 
until the initialization timer reaches, for example, 
one second. If the vehicle 19 starts moving before 
initialization is complete, the average of the maximum 
and minimum offset values (that have been calculated 
over a long time period, such as the entire operating 
time of the vehicle 19) are computed and used as the 
initial offset values. 

[0029] In one embodiment, the average of the yaw 
rate and roll rate is limited to between, for example, 
+-3 . 5deg/sec , because the sensor specification defines 
the +-3.5deg/sec example as the worst case zero point 
offset for the rate sensors. 
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[0030] Initialization occurs when the vehicle 
ignition is turned on, or electrical power is 
otherwise supplied to the vehicle systems. If the 
vehicle 19 is standing still when the ignition is 
turned on, then the offsets are computed such that the 
filtered Ax (Longitudinal Acceleration) and Ay 
(Lateral Acceleration) values are approximately equal 
to the Ax and Ay values that existed and were written 
to the controller EE PROM 47 (Electrically Erasable 
Programmable Read-Only Memory) when power was removed 
from the system 18 at the end of the previous driving 
cycle. 

[0031] If the vehicle 19 was not standing still 

when the previous EE PROM 47 write occurred or an 
EE PROM 47 write did not occur during the last ignition 
off, then the offsets is computed by taking the 
average of the maximum and minimum value. The system 
assumes that the geographical location of the vehicle 
19 has not been changed since the vehicle 19 has been 
shut off. Also to minimize error if the vehicle 19 
has been moved during an ignition off, the Ax and Ay 
offset calculations are limited to within the 
boundaries of maximum and minimum values from EEPROM 
47 . 

[0032] An example of initialization logic includes: 
If ( (VehicleStandStill) !(INIT_FLAG & 

INITIALIZATION_COMPLETE) {if ( ( RollAcceleration < = 
VEHICLE_STAND_STILL_ROLL_ACC) && ( YawAcceleration < = 
VE H I C L E_S TAND_S T I L L_Y AW__AC C ) ) ; 
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{if ( ! <RSC_SENSORS_DISTURBED) ) 

{RollRateOf fset += FilteredRollRate / 

InitializationTimer; 

YawRateOf f set += FilteredYawRate / 
InitializationTimer; 

InitializationTimer ++; } 

If (InitializationTimer >= ONE_SEC_UP) 
{INIT_FLAG |= INITIALIZATION_COMPLETE; } } 
Else 

{InitializationTimer =0; /* Restart the 

initialization */}} 
else 

{RollRateOf fset = LIMIT ( +-3 . 5deg/sec , 

(MAX_RR_OFST_EE + MIN_RR_OFST_EE )/2); 

YawRateOf fset = LIMIT(+-3 . 5deg/sec, 

(MAX_YR_OFST_EE + MIN_YR_OFST_EE) 12 ) ; 

IN I T — FLAG |= INITIALIZATION_COMPLETE; } 

[0033] For the aforementioned logic, one example of 
offset initialization external inputs includes: 



RSC Code Name 


Logic Description Name 


8 . Get_vehicle_standstill ( ) : A 
macro to determine if the vehicle is 
standing still 


VehicleStandStill 


9 . s s __mp s s_LONG__ACC : Raw 
Longitudinal Acceleration 


RawAx 


10. ss_mpss_LAT_ACC : Raw Lateral 
Acceleration 


RawAy 


11. ss_dps_FLT_ROLL_RATE: Filtered 
and compensated roll rate. 


FilteredRollRate 


12. ss_dps_FLT_YAW_RATE: Filtered 
and compensated yaw rate . 


FilteredYawRate 


13. ROLL_ACCELERATION2 : Roll Rate 
Acceleration. 


RollAcceleration 


14. YAW__ACCELERATION2 : Yaw Rate 
Acceleration. 


YawAcceleration 
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15 . RSC_SENSOR__CALIBRATION_VALUES 
[ Rr_o f s t_max ] : Roll rate maximum 
value from EEPROM (over a long time 
period, such as total operating time 
of the vehicle) 


MAX_RR__OFFSET_EE 


1 6 . RSC_SENSOR_CALIBRATION_VALUES 
[Rr_of st_min] : Roll rate minimum 
value from EEPROM (over a long time 
period, such as total operating time 
of the vehicle) 


MIN_RR_OFFSET_EE 


17 . RSC_SENSOR_CALIBRATION_VALUES 
[Yr_of stjuax] : Yaw rate maximum 
value from EEPROM (over a long time 
period, such as total operating time 
of the vehicle) 


MAX__YR_OFFSET_EE 


18 . RSC_SENSOR_CALIBRATION_VALUES 
[Yr__of st__min] : Yaw rate minimum 
value from EEPROM (over a long time 
period, such as total operating time 
of the vehicle) 


MIN_YR_OFFSET_EE 


19. RSC_SENSOR_CALIBRATION_VALUES 
[Along_of st_max] : Longitudinal 
Acceleration maximum value from 
EEPROM (over a long time period, 
such as total operating time of the 
vehicle) 


MAX_AX__0 FFS ET_E E 


20. RSC_SENSOR_CALIBRATION_VALUES 
[Along_of st_min] : Longitudinal 
Acceleration minimum value from 
EEPROM (over a long time period, 
such as total operating time of the 
vehicle) 


MIN_AX_OFFSET_EE 


21. RSC_SENSOR_CALIBRATION_VALUES 
[Alat_of st_max] : Lateral 
Acceleration maximum value from 
EEPROM (over a long time period, 
such as total operating time of the 
vehicle) 


MAX_AY_OFFSET_EE 


22 . RSC_SENSOR_CALIBRATION__VALUES 
[Alat_of st_min] : Lateral 
Acceleration minimum value from 
EEPROM (over a long time period, 
such as total operating time of the 
vehicle) 


MIN__AY__OFFSET_EE 


2 3 . RSC_SENSOR_CALIBRATION_VALUES 
[Long_acc] : Longitudinal 
Acceleration stored in EEPROM from 
the previous ignition cycle 


AxEE 


24 . RSC_SENSOR_CALIBRATION_VALUES 
[Lat_acc] : Lateral Acceleration 
stored in EEPROM from the previous 
ignition cycle 


AyEE 
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25 . Get_rsc_eeprom_var_bit (VEHICLE 
_STAND_STILL) : A macro to determine 
from EE PROM if vehicle was standing 
still last time the EEPROM write was 
made . 


Veh i c 1 e_wa s _ s t andi ng_s 
till_during_last_ignit 
ion_of f 


26 . Get_rsc_eeprom_var_bit (NO_ EEPROM 
_STORAGE_RSC ) : A macro to determine 
from EEPROM if an EEPROM write is made 
in the last ignition cycle. 


An_EE PROM_wr i t e_wa s _ma 
de_dur i ng_l a s t_i gni t i o 
n_off 



[0034] One example of offset initialization outputs 
include : 



RSC Code Name 


Logic Description 
Name 


1 . s S_mp s s_LAT_ACC_0FFS ET 


AxOf fset 


2 . ss_mpss_LONG_ACC_OFFSET 


AyOf f set 


3 • ss_mpss_ROLL_RATE_OFFSET 


RollRateOf fset 


4 . s s_mp s s_YAW_RATE_OFFSET 


YawRateOf f set 


5. ss_mpss_R0LL_RATE_0FFSET__INIT: The 
initial value of roll rate offset. 


InitialRollRateOf f se 
t 


6. ss_jnpss_YAW_RATE_INIT: The initial 
value of filtered and compensated yaw 
rate . 


InitialYawRate 


7 . Clr_rsc_eeprom_var_bit (N0_EEPR0M 
_STORAGE_LAST_CYCLE) : A macro that 
clears the specified bit in shadow 
EEPROM . 




8 . bf_uc_INITIALIZATION_STATUS : Flags 
set during initialization 


INITIALIZATION 
^COMPLETE 



[0035] Offset initialization parameters include: 
rr_of st_eep_max, which is the maximum limit that the 
roll rate offset can be; yr_of st_eep__max, which is the 
maximum limit that the yaw rate offset can be; 
along__of st_eep_max, which is the maximum limit that 
the longitudinal acceleration offset can be; 
alat_of st_eep_max, which is the maximum limit that the 
lateral acceleration offset can be. 
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[0036] One example of offset initialization state 
variables includes : bf_uc_initialization_status , which 
is an initialization flag for checking initialization 
condition status, and ss_tim_initialization_timer , 
which sets a start time for the initialization timer. 

[0037] In one embodiment of the present invention , 
if the vehicle 19 starts moving before the 
initialization completes, a flag is set, and an 
initial value of the Ax and Ay offsets is computed by 
taking the maximum and minimum offsets values from 
EE PROM 47. When the initial value is calculated by 
taking the average of the maximum and the minimum 
value, it is always limited to, for example, +- 
1.5m/sec A 2 for the acceleration sensors, because the 
acceleration sensors should not experience the worst 
case zero point offset of greater than, for example, 
O.llg. An example of logic therefore includes: 

If ( (VehicleStandStill) 

ScSc I ( INIT_FLAG & INITIALI ZATI0N — COMPLETE ) 

ScSc (Vehicle_was_standing_still_during_last_ignitio 

n_of f ) && (An_EEPROM_write__was_made_during_last_ignition 

.off) ) 

{if ( (RollAcceleration<=VEHICLE__STAND_STILL_ROLL_A 

CC) 

ScSc ( YawAcceleration < = 

VEHICLE_STAND_STILL_YAW_ACC ) ) 

{if ( ! (RSC_SENSORS_DISTURBED) ) 

{AxOffset + = (RawAx - AxEE) * L00P_TIME_SEC ; 
AyOffset += (RawAy - AyEE) * L00P_TIME_SEC ; 
AxOffset = max <MIN_AX_0FST_EE , AxOffset) ; 
AxOffset = min (MAX_AX_OFST_EE , AxOffset) ; 
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AyOffset = max (MIN_AY_OFST_EE, AyOffset); 

AyOffset = min ( MAX__A Y_0 F ST_E E , AyOffset); 

InitializationTimer ++; } 

If (InitializationTimer >= ONE__SEC__UP ) 
{ INIT__FLAG | = INITIALIZATION_COMPLETE; } } ; an initial 
value of the Ax and Ay offsets is computed by taking 
the maximum and minimum offsets values from EE PROM 47. 

else 

{InitializationTimer =0; /* Restart the 

initialization */} } 

else{AxOf fset = LIMIT (+- 

1 . 5m/sec^2 , (MAX_AX__OFST_EE + MIN_AX_OFST_EE ) /2 ) ; 
limits the Ax offset max and min to 1 . 5m/sec ys 2 . 

AyOffset = LIMIT ( +-1 . 5m/ sec ^2 , <MAX_AY_OFST_EE + 
•MIN_AY__OFST_EE) /2) ; limits the Ay offset max and min 
to 1.5m/sec*2. 

INIT_FLAG |= INITIALIZATION_COMPLETE; } 

[0038] In operation block 64, a second offset 
correction signal is generated for the vehicle dynamic 
sensor (21, 28, 30, or 31) when the vehicle 19 is 
moving. The second offset signal deals with moving 
conditions of the vehicle. Embodiments thereof are 
discussed below. 

[0039] If the vehicle 19 is turning continuously 
for a given time period (15 seconds is used in this 
example) in one direction, offset compensation may be 
paused for yaw rate, roll rate, and Ay. If the 
vehicle 19 is turning continuously to the right hand 
side, a negative turn flag is set and if it is turning 
to the left hand side, a positive turning flag is set. 
Logic to illustrate this includes: 
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If ( (FltYawRate < 0 && SWA < RIGHT_TURN) 
{ POS_TURNING_COUNTER -= 2; 
NEG_TURNING_COUNTER + +; 

POS_TURNING_COUTNER = min ( POS_TURNING_COUNTER, 
MAX_COUNT_VALUE ) ; 

NEG_TURNING_COUNTER = max { NEG_TURNING_COUNTER , 
MIN_COUNT_VALUE) ; 

If { TURNING_JTIME < NEG_TURNING_COUNTER) 

SET_SUSTAINED_NEG_TURNING_15SEC ; 

Else 

{If ( POS_TURNING_COUNTER <= TURNING_TIME ) 
CLEAR_SUSTAINED_POS _TURNING_1 5 SEC ; 
CLEAR_SUSTAINED_NEG_TURNING_15SEC; } } 
If ( (FltYawRate > 0 && SWA > LEFT_TURN) 
{ NEG__TURNING_COUNTER -= 2; 
POS_TURNING_COUNTER + +; 

NEGJTURNING_COUTNER = min (NEGJTURNING_COUNTER, 
MAX_COUNT_VALUE ) ; 

POS_TURNING_COUNTER = max ( POSJTURNING_COUNTER, 
MIN_COUNT_VALUE) ; 

If (TURNING_TIME < POS_TURNING_COUNTER) 

SET_SUSTAINED_P0S_TURNING_15SEC ; 

Else {If (NEGJTURNING_COUNTER<= TURNING_TIME ) 

CLEAR_SUSTAINED_NEGJTURNING_15SEC ; 

CLEAR_SUSTAINED_P0SJTURNING_15SEC; } } 

[0040] To clarify the aforementioned logic, an 
example of dynamic offset external inputs includes: 

[0041] An example of dynamic offset variables 
includes : 
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RSC Code Name 


Logic Description Name 


1. Get__vehicle_standstill ( ) 




2 . bf_uc_INITIALIZATION_STATUS 




3 , ss_deg_STEERING_WHEEL_ANGLE 




4 . Get_ayc_reverse_det_possible ( ) 




5. ss_dps_FLT_YAW_RATE 


FltYawRate 


6. ss_deg_PITCH_ANGLE_ESTIMATE 


PitchAngleEst 


7. ss_deg_PITCH_OFFSET_ESTIMATE 


PitchOf f set 


8. ss_deg_REL_PITCH_ANGLE 


PitchRelative 



[0042] An example of dynamic offset outputs 
includes : 



RSC Code Name 


Logic Description 
Name 


1 . ss_dps_ROLL_RATE_OFFSET 


RollRateOf f set 


2 . ss__dps_YAW_RATE_OFFSET 


YawRateOf f set 


3 . ss_dps_L0NG_ACC_0FFSET 


AxOf f set 


4. ss_dps_LAT_ACC_OFFSET 


AyOf f set 



[0043] One embodiment of dynamic offset parameters 
includes : TURNING JTIME ; MAX_COUNT__VALUE ; 

MIN_COUNT_VALUE ; Rr_o f s t_eep„max ; Yr_o f s t _e ep_max ; 
Ala t_o f s t_e ep__max / Al ong_o f s t __e ep_max ; and 

p_L00P__TIME__SEC . 



[0044] Under most normal driving circumstances, the 
average yaw rate and the average roll rate should be 
close to zero over a long period of time. Any time a 
non-zero value is detected for the yaw rate and/or 
roll rate, they are compensated for continuously by a 
very small amount, which is equal to the maximum 
temperature drift rate for the signal. 

[0045] Over a long period of time, the average road 
bank angle is considered to be zero. Any time a non- 
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zero value is detected, lateral acceleration offset is 
adjusted in the controller 26 such that lateral 
acceleration will drive road bank angle to zero. 

[0046] Over a long period of time, the average road 
pitch angle is considered to be zero. Any time a non- 
zero value is detected, longitudinal acceleration 
offset is adjusted in the controller 26 such that 
longitudinal acceleration will drive pitch angle to 
zero. Road pitch angle is calculated by taking the 
current pitch angle estimate and then subtracting the 
relative pitch angle and the pitch angle offset. 
Logic to illustrate this includes: 

RoadPitchEst = PitchAngleEst - PitchOffset 
Pi tchRelative ; 

If (RoadPitchEst > 0) AxOffset 

MAX_AX_DRIFT_RATE ; 

Else if (RoadPitchEst < 0) 

AxOffset += MAX_AX_DRIFT_RATE; 

If ( I ( GET_SUSTAINED_P0S_TURNING_1 5 SEC) ) 

{if (FltYawRate > 0) 

YawRateOf f set += MAX__YR_DRI FT__RATE ; 

If ( ! (GET_SUSTAINED__NEG_TURNING_15SEC) ) 

{if (RollRate > 0) RollRateOf f set += 

MAX_RR_DRIFT_RATE ; } 

if (InstBankAngleEstimate < 5 && 

InstBankAngleEstimate > 0) 

Ay 0 f f s e t + = MAX_AY_DRIFT_JRATE ; } 

if ( ! (GET_SUSTAINED_NEG_TURNING_15SEC) ) 

{if (FltYawRate < 0) 

YawRateOf fset -= MAX_YR_DRIFT_RATE; 

If ( ! (GET_SUSTAINED_P0SJTURNING_15SEC) ) 

{if (RollRate < 0) 
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RollRateOf f set -= MAX_RR_DRIFT_RATE; } 
if {InstBankAnbleEstimate > -5 && 

InstBankAngleEstimate < 0) 

AyOffset -= MAX_AY_DRIFT_RATE ; 

[0047] In operation block 66, a third offset 
correction signal is generated for a vehicle dynamic 
sensor when the vehicle 19 is at rest. Embodiments 
thereof are included below. 

[0048] An example of offset resting external inputs 
includes : 



RSC Code Name 


Logic Description Name 


1 . bf _uc_INITIALIZATION_STATUS : 
Flag to determine if initialization 
is completed 


INITIALIZATION_COMPLETE 


2. ss_dps_R0LL_ACCELERATI0N2 : Roll 
Acceleration 


RollAcceleration 


3 . ss_dps_YAW_ACCELERATION2 : Yaw 
acceleration 


YawAcceleration 



[0049] An example of offset resting state variables 
includes : 



RSC Code Name 


Logic Description Name 


1 . ss_dps_FLT_YR_COMP_REST : 
Filtered and compensated resting yaw 
rate 




2 . ss_dps_RESTING_YR_OFFSET : 
Resting slow drifting offset. 


RestingYROf f set 


3. bf_uc_OFFSET_FLAG: Flags that 
are set during resting 


VEHICLE_STOPPED_FOR_ONE 
_SEC 


4 . ss_mpss_FLT_LONG__ACC_RESTING : 
Initial resting longitudinal 
acceleration 


HOLD_RESTING_VALUES 


5 . ss_mpss_FLT_LAT_ACC_RESTING : 
Initial resting lateral acceleration 


FltAy Re sting 


6. ss_RESTING_UPDATE__CLOCK: Clock 


FltAxResting 
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[0050] An example of offset resting outputs 
includes : 



RSC Code Name 


Logic Description Name 


1 . CLEAR_SUSTAINED_POS_TURNING 
_15SEC: Clear the continuous 15 
second turn counter 




2 . CLEAR_SUSTAINED_NEG_TURNING 
_15SEC: Clear the continuous 15 
second turn counter 




3 . ss_dps_YAW_RATE_OFFSET 


YawRateOf f set 


4 . ss_dps_ROLL_RATE_OFFSET 


RollRateOf fset 


5 . ss_dps_LONG_ACC_OFFSET 


AxOf f set 


6 . ss_dps_LAT_ACC_OFFSET 


AyOf f set 



[0051] An example of offset resting parameters 
includes : 1 . Yr_of st_eep_max; 2 . 

ALLOWED_RESTING_ROLL_ACC : Acceleration that is allowed 
when standing still; 3. ALLOWED_RESTING_YAW_ACC : 
Acceleration that is allowed when standing still. 

[0052] After the vehicle 19 comes to a complete 
stop, to ensure that no transient signals (such as may 
be caused by the vehicle 19 rocking, bouncing, or 
swaying on its suspension) are received in the 
controller 26, the controller 26 waits, for example, 
an additional second. An example of logic thereof 
includes : 

If ( ( INIT_FLAG & INITIAL I ZATION_COMPLETE ) 
&& ( ! (RSC_SENSORS_DISTURBED) ) ) 

{if ( ! ( OFFSET_FLAG & 

VEHICLE_STOPPED_FOR_ONE_SEC ) 

{ RESTING_UPDATE_CLOCK ++ ; 

If (RESTING_UPDATE_CLOCK >= 0NE_SEC_UP) 

OFFSET_FLAG | = VEHICLE_STOPPED_FOR_ONE_SEC} } 
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[0053] An average value for filtered lateral 
acceleration (Ax) and longitudinal acceleration (Ay) 
for a period of 1 second is generated after the 
vehicle 19 has come to a stop. These values are used 
to compute the Ax and Ay offsets during standing 
still. Any drifts in Ax and Ay are considered to be 
due to sensor drifts and is compensated for by 
applying the appropriate offset. An example of logic 
and inputs therefore follow. 

[0054] One example of filtering and compensation 
external inputs includes : 



RSC Code Name 


Logic Description Name 


1 . Get_vehicle_standstill ( ) 




2 . bf_uc_INITIALIZATION_STATUS 




3 . ss_dps_YAW_RATE 


RawYawRate 


4 . ss_dps_ROLL_RATE 


RawRollRate 


5 . s s_mp s s_LONG_ACC 


RawAx 


6 . S s_mp s s_LAT_ACC 


RawAy 


7 . ss_mpss_YAW_KATE_OFFSET 


YawRateOf fset 


8 . ss_mpss_ROLL_RATE_OFFSET 


RollRateOf f set 


9 . ss_mpss_LONG_ACC_OFFSET 


AxOf £ set 


10 . ss_mpss_LAT_ACC_OFFSET 


AyOf f set 


11. s s_dps_FLT_ROLL_RATE 


FltRollRate 


12. s s_dp s_FLT_YAW_RATE 


FltYawRate 


13 . ss_mpss_FLT__LONG__ACC 


Fit Ax 


14. ss_mpss_FLT_LAT_ACC 


Fit Ay 



[0055] One example of filtering and compensation 
state variables includes : 
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RSC Code Name 


Logic Description Name 


1 . uc_LONG_TERM_COMP_UPDATE_CLOCK 




2 . s s_dp s_YR_C0MP_UNFLT 


RawYawRate 


3. ss_dps_RR_COMP_UNFLT 


RawRollRate 


4 . ss_dps_AX_COMP_UNFLT 


RawAx 


5 . s s_dps_AY_COMP_UNFLT 


RawAy 


6. uc_RR_POS_CNTR 


RR_POS_CNTR 


7 . uc__RR__NEG_CNTR 


RR__NEG_CNTR 


8. uc_YR_POS_CNTR 


YR_POS_CNTR 


9. UC_YR_NEG_CNTR 


YR_NEG_CNTR 


10. uc_AX_POS_CNTR 


AX_POS_CNTR 


1 1 . UC_AX_NEG_CNTR 


AX_NEG_CNTR 


12 . uc_AY_POS_CNTR 


AY_POS_CNTR 


13 . uc_AY_NEG_CNTR 


AY_NEG_CNTR 



[0056] One example of filtering and compensation 
outputs includes : 



RSC Code Name 


Logic Description Name 


1. bf_uc_OFFSET_FLAG 




2 . ss_dps_FLT_ROLL_RATE 


FltRollRate 


3. ss_dps_FLT_YAW_RATE 


FltYawRate 


4 . s s_mp s s_FLT_LONG_ACC 


FltAx 


5 . s s_mp s s_F LT_LAT_AC C 


Fit Ay 



[0057] One example of filtering and compensation 
parameters includes: RR_MAX__L00P ; RR_DECR_CNTR; 
YR_MAX_L00P; YR_DECR__CNTR; AX_MAX_L00P; AX_DECR_CNTR; 
AY_MAX_L00P; and AY__DECR_CNTR . 



[0058] Filtering and compensation logic includes 
the computed values of the offsets taken out from the 
raw value before they are filtered. Therefore: 
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RawRollRate 
YawRateOf f set; 
AyOf f set . 



[0059] An embodiment of logic for generating 

offsets during standing still includes: 

if ( (OFFSET_FLAG & VEHICLE_STOPPED_FOR_ONE_SEC ) 
&& ! (OFFSET_FLAG & HOLD_RESTING_VALUES ) ) 
{FltAxResting = ( (FltAxResting * TempCounter) + 

FltAx) / (TempCounter + 1) ; 

FltAyResting = ( (FltAyResting * TempCounter) + 

FltAy) / (TempCounter + 1) ; 
TempCounter ++; 

If (TempCounter >= 0NE_SEC_UP) 
OFFSET_FLAG |= HOLD_RESTING__VALUES ; } 

[0060] If any vehicle rolling motions or change in 
yaw is picked up when stopped, 

VEHICLE_STOPPED_FOR_ONE_SEC and HOLD_RESTING_VALUES 
flags is unset. Resting Ax and Ay values (step 2) is 
re-computed after this. Logic therefore includes: 
If (INIT__FLAG & INITIALIZATION_COMPLETE) 
{if { { RollAcceleration <= 

VEHICLE_STAND_STILL_ROLL_ACC ) 

ScSc (YawAcceleration < = 

VEHICLE_STAND_STILL_YAW_ACC) ) 

{ OFFSET__FLAG &= ~VEHICLE_STOPPED_FOR._ONE_SEC 
OFF SET_FLAG &= ~HOLD_RESTING_VALUES ; } } 

[0061] Any changes in lateral acceleration and 
longitudinal acceleration are assumed to be due to 
sensor drifts when the vehicle 19 is at a standstill. 
Logic to illustrate this includes: 
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If ( ( VEHICLE_STOPPED_FOR_ONE_SEC ) 
ScSc (HOLD_RESTING_VALUES ) 

&& (ROLL_ACCELERATION < ALLOWED_RESTING_ROLL_ACC ) 

ScSc { YAW__ACCELERATI ON < ALLOWED_RESTING_YAW_ACC) ) 

{if (FltAx > FltAxResting) 

FltAxOf f set += MAX_AX__DRIFT_RATE ; 

Else if (FltAx < FltAxResting) 

FltAxOf f set -= MAX_AX_DRIFT_RATE ; 

if (FltAy > FltAyResting) 

FltAyOffset + = MAX_AY_DRIFT_RATE ; 

Else if (FltAy < FltAyResting) 

FltAyOffset -= MAX_AY_DRIFT_RATE; } 

[0062] During a vehicle standstill, offset 
compensation is performed within the controller 2 6 
such that the filtered roll and yaw rate is zero. 
Logic to illustrate this includes: 

I f ( VEHICLE__STOPPED_FOR_ONE_SEC ) 

{Temp = RE S T I NG_T I ME_C ON S T ANT / LOOP_TIME; 
RollRateOf f set += FltRollRate * Temp; 
YawRateOf f set += FltYawRate * Temp; } 

[0063] If the vehicle 19 is turned while standing 
still, like when the vehicle 19 is stopped/parked on a 
turntable of a parking facility (referred to as a 
turntable event) , the offset compensation is held 
constant until the turning is completed by calculating 
a resting yaw rate compensation value while the 
vehicle 19 is standing still. No fast compensation is 
performed while the vehicle 19 is standing still for 
the resting yaw rate. If this value exceeds a 
threshold, offset compensation is paused until it is 



23 



below the threshold. Logic to illustrate this 

includes : 

FltYRRest = FLTR__COEFF * FltYRRest + (1 - 
FLTR_COEFF) * (RawYawRate - RestingYROf fset ; 
If (FltrYRRest > 0) 

RestingYROf f set += MAX_ YR_DR I F T__RAT E ; 
Else if (FltrYRRest < 0) 
RestingYROf f set -= MAX_YR_DRIFT__RATE ; 
If (FltrYRRest > MAX_REST_YR) 

{ OFFSET^ FLAG &= - VEHICLE_STOPPED_FOR_ONE_SEC ; 
OFFSET__FLAG &= ~ HOLD_RE S T I NG_VALUE S ; } 

[0064] If an initialization has taken place during 
a turn table type event, it is corrected when the 
vehicle 19 is standing still after initialization. In 
such event, the offsets value is reset to the average 
of the maximum and the minimum values from EEPROM 47 . 
In such cases, the rate sensors (27, 28, 30, or 31) 
are limited to, for example, +-3 . 5deg/sec and the 
acceleration sensors is limited to, for example, +- 
1.5m/sec^2. The controller 26 achieves this by taking 
the initial value of the yaw rate after the completion 
of offset initialization and FltYRRest. Logic to 
illustrate this includes: 

I f ( INTI ALI Z ATI0N_ JUST_F INI SHED ) 

{if (FltYRInitial > FltYRRest + 2) 

| | (FltYRInitial < FltYRRest - 2) 

{RollRateOf fset = LIMIT (+-3.5, (MAX_RR_OFST__EE + 
MIN_RR_OFST_EE ) /2) ; 

YawRateOf fset = LIMIT (+-3.5, (MAX_JYR_OFST_EE + 
MIN_YR_OFST_EE ) / 2 ) ; 

AxOffset = LIMIT( + -1.5, (MAX_AX_OFST_EE + 

MIN_AX_OFST_EE ) /2) ; 
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AyOffset = LIMIT (+-1 . 5 , (MAX_AY_OFST_EE + 
MIN_AY_OFST_EE) /2 ) ; } } 

[0065] In operation block 68, the vehicle dynamic 
sensor (27, 28, 30, or 31) is corrected in response to 
the first offset correction signal, the second offset 
correction signal, and the third offset correction 
signal . 

[0066] In other words, the computed values of the 
offsets are taken out from the raw sensor value before 
the sensors (27, 28, 30, or 31) are filtered. Logic 
to illustrate this includes: 

RawRollRate -= RollRateOf f set / 

RawYawRate -~ YawRateOf f set ; 

RawAx - = AxOffset; 

RawAy -= AyOffset; 

[0067] The roll rate sensor 31 is filtered by 
limiting the roll rate velocity to a maximum of 
RR_xxx_CNTR * RR_DELTA. These values are established 
by taking the worst-case conditions (the maximum roll 
rate) from data. The slope is continually increased 
by increasing the counter. The counter is limited the 
RR_MAX_LOOP value. So, the maximum rate change 
experienced by the roll rate sensor 31 is RR__MAX_L00P 
* RR_DELTA. Logic to illustrate this includes: 
if (RawRollRate > FltRollRate) 

{if (RR_POS_CNTR < RR__MAX„LOOP ) RR_POS_CNTR ++; 
if (RR_NEG_CNTR >= RR_DECR_CNTR ) RR_JSfEG__CNTR - = 
RR_DECR_CNTR; 

else RR_NEG_CNTR = 0; 

FltRollRate += RR_POS_CNTR * RR__DELTA; 
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If (RawRollRate < FltRollRate) FltRollRate = 
RawRollRate; } 

else {if (RR_NEG_CNTR < RR_MAX_LOOP) RR_NEG_CNTR 

++; 

if (RR_POS_CNTR >= RR_DECR_CNTR) RR_POS_CNTR - = 
RR_DECR_CNTR; 

else RR_POS_CNTR = 0; 

FltRollRate - = RR_NEG_CNTR * RR_DELTA; 
If (RawRollRate > FltRollRate) FltRollRate = 
RawRollRate; } 

[0068] The same logic is applied to filter Yaw 
Rate : 

if (RawYawRate > FltYawRate) 

{if (YR_POS_CNTR < YR_MAX_LOOP) YR_POS_CNTR ++; 
if ( YR_JNTEG__CNTR >= YR_DECR_CNTR ) YR__NEG„CNTR - = 
YR_DECR_CNTR; 

else YR_NEG_CNTR = 0; 

FltYawRate += YR_POS_CNTR * YR_DELTA; 
If (RawYawRate < FltYawRate) FltYawRate 
RawYawRate; } 

else {if (YR__NEG_CNTR < YR_MAX_L00P ) YR_NEG_CNTR 

++; 

if (YR„POS__CNTR >= YRJDECR_CNTR ) YR_POS_CNTR -= 
YR_DECR_CNTR; 

else YR_POS_CNTR = 0; 

FltYawRate -= YR_NEG_CNTR * YR_DELTA; 
If (RawYawRate > FltYawRate) FltYawRate 
RawYawRate; } 

[0069] The same logic is applied to filter 
Longitudinal Acceleration: 
if (RawAx > FltAx) 
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{if (AX_POS_CNTR < AX_MAX_LOOP) AX_POS_CNTR + + ; 
if <AX_NEG_CNTR >= AX_DECR_CNTR) AX_NEG_CNTR - = 
AX_DECR_CNTR; 

else AX_NEG_CNTR = 0; 

Fit Ax += AX_POS_CNTR * AX_DELTA; 

If (RawAx < FltAx) Fit Ax = RawAx; } 

else {if (AX_NEG_CNTR < AX_MAX_LOOP) AX__N E G__C NTR 

++; 

if (AX_POS_CNTR >= AX_DECR_CNTR) AX_POS_CNTR - = 
AX_DECR_CNTR; 

else AX_POS_CNTR = 0; 

FltAx -= AX_NEG_CNTR * AX_DELTA; 

If (RawAx > FltAx) FltAx = RawAx;} 

[0070] The same logic is applied to filter Lateral 
Acceleration : 

if (RawAy > Fit Ay) 

{if (AY_POS_CNTR < AY_MAX_L00P) AY_POS_CNTR + +; 
if ( AY_NEG_CNTR >= AY_DECR_CNTR) AY_NEG_CNTR - = 
AY_DECR__CNTR; 

else AY_NEG_CNTR = 0 ; 

FltAy += AY_POS_CNTR * AY_DELTA; 

If (RawAy < FltAy) FltAy = RawAy; } 

Else 

{if (AY_NEG_CNTR < AY_MAX_L00P) AY_NEG_CNTR + +; 
if (AY_POS_CNTR >= AY_DECR_CNTR ) AY_POS_CNTR - = 
AY_DECR__CNTR; 

else AY_POS_CNTR = 0; 

FltAy - = AY_NEG_CNTR * AY_DELTA; 

If (RawAy > FltAy) FltAy = RawAy;} 

[0071] While particular embodiments of the 
invention have been shown and described, numerous 
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variations and alternate embodiments will occur to 
those skilled in the art. Accordingly, it is intended 
that the invention be limited only in terms of the 
appended claims. 
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